#include <iostream>
#include <ros/ros.h>
#include "can_device_interface/canmsg.h"
int main(int argc,char** argv)
{
    ros::init(argc,argv,"can_device_pack_test");
    ros::NodeHandle n;
    ros::Publisher pack_test_pub;
    pack_test_pub = n.advertise<can_device_interface::canmsg>("control_msg",10);
    int frame_id = 0;
    ros::Rate loop_rate(10);
    can_device_interface::canmsg msg;
    while (ros::ok)
    {
        msg.header.frame_id = frame_id;
        pack_test_pub.publish(msg);
        frame_id++;
        frame_id++;
        if (frame_id >= 10000)
            frame_id = 0;
        loop_rate.sleep();
    }
    return 0;
}